/*********************************************************************
 * 
 *  2 wheel robot code for PICSTAR Club
 *
 *  November 2013
 ********************************************************************/

/** I N C L U D E S **********************************************************/
#include <p18cxxx.h>
#include "typedefs.h"                        // Required
#include "io_cfg.h"                                 // Required
#include "user.h"                              // Modifiable
#include "BT_Command.h"

/** V A R I A B L E S ********************************************************/
#pragma udata

/** V E C T O R  R E M A P P I N G *******************************************/

extern void _startup (void);        // See c018i.c in your C18 compiler dir
#pragma code _RESET_INTERRUPT_VECTOR = 0x001000
void _reset (void)
{
    _asm goto _startup _endasm
}
#pragma code

void main(void)
{
    initializeRobot();
    mLED_1_On();        // show routine started

    while(1)
    {
    blinkStatus();  // blink slow speed
    getBTCommand(); // read UART, change param if required
    balanceRobot(); // run main task
    }//end while
}//end main

/** EOF main.c ***************************************************************/
